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Introduction 


An automated docking system must have a reliable method for determining range and 



Geometric Model of the Imaging System 

For the purpose of analysis, the lens of the camera is modelled as a pinhole. In a 
pinhole camera, every object is in focus, regardless of its distance from the camera. For 
actual lenses, only objects at a given distance, determined by the lens equation, are in 
perfect focus. Points at other distances from the camera are imaged as "blur circles" 
whose diameters are proportional to the distance of the point from the ideal distance and 
to the lens diameter while inversely proportional to the focal length of the lens. The 
target detection system being developed, however, uses the centroids of detected images. 
In a statistical sense, the centroid of such an image should be the same whether or not it is 
in perfect focus. Thus, for purposes of geometrical analysis, the pinhole model is 
adequate. 

While the image plane lies behind the lens at a distance / equal to the focal length of 
the lens, an imaginary projected image plane may lie at any distance behind or in front of 
the lens. For ease of illustration, a projected image plane is frequently used. We will use 
a projected image plane lying a distance /in front of the lens (Figure 2). A right-handed 
xyz coordinate system is used, with the positive x-axis extending from C through the 
center of the projected image plane, and with the positive y and z-axes extending 
vertically upward and horizontally to the right, respectively. 


Determination of Target Range 


In Figure 3, C denotes the geometrical center of the lens, Pj,Pj, and Pj represent the 
retro-flectors in the target, and P { , P 2 , and P 3 represent the respective images in the image 
plane. The symbols P 1 ,P 2 ,P 3 ,P,',P 2 , and P 3 represent the vectors from C to the 
respective points on the target and on the image plane. The vector components of 
P, ,P 2 , and P 3 are, respectively, (/,a, ,6, ), (f,a 2 ,b 2 )„ and (f,a 2 ,b 2 ). The magnitudes 

of the vectors P,',P 2 , and P 3 , representing the distances to the retro-reflectors, are r h r 2 , 
and r 3 , respectively. The fixed distance from retro-reflector 1 (on the center post) to 
retro-reflectors 2 and 3 is D. The fixed distance between retro-reflectors 2 and 3 is L. 

The height of the center post is H. The angle between vectors P, and P 2 is 0 12 . The angle 
between vectors P, and P 3 is 0 13 . The angle between vectors P 2 and P 3 is 0 23 . 

The coordinates of P, ,P 2 , and P 3 are determined directly from the output of the 
imaging system. The angles 0 12 , 0 13 , and 0 23 are determined by the relations 
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Using the Law of Cosines, it is seen that 

r 2 +r 2 2 -2 r,r 2 cos0 12 = Z) 2 
r, 2 + r 3 2 - 2r,r 3 cos0 13 = P> 2 
r 2 2 + r 3 2 - 2r 2 r 3 cos0 23 = L 2 

In general, a set of three quadratic equations in three variables can have as many as 
eight distinct solutions. In this case, however, there are at most four solutions where all 
values of the variables are positive, since, if (r, ,r 2 ,r 3 ) is a solution, then so is 
(-r, , -r 2 ,—r 3 ). In point of fact, there are never more than three distinct all positive 
solutions. Three solutions occur when 0 12 = 0 13 . If 0 12 * 0 (3 , then there are only two 
distinct solutions in which all three variables are postitive. In either case, only one of the 
solutions has the reflector on the center post pointed toward the camera. The other 
solutions represent situations where the center post points away from the camera. Since 
such a target orientation would be undetectible, such a solution may be discarded. 

In fact, the method of solution used by Marshall Space Flight Center avoids the 
necessity of computing all solutions and then rejecting some. It is assumed that the 
image of the point halfway between P,'and P 3 ' (the base of the center reflector post) 
would lie at the point halfway between the images of those points in the image plane. 
While this assumption is not true, it is a good approximation in the case of the correct 
solution, and a bad approximation for the spurious solutions. Using an iterative routine 
(the Newton-Rafson method), the initial guess is improved upon until the system 
converges to the correct solution . The iterative routine also computes the pitch, roll and 
yaw of the target . This information, along with the range to the target, is updated and the 
corresponding rates of change are computed. All range, orientation and rate of change 
information is then passed along to the guidance routines so that necessary course 
corrections can be computed for the docking maneuver. 

Alternate Solution Method 

While the method described above is sufficient, the following method is presented for 
possible comparison of speed or accuracy. 

Assuming that 0 12 > 0 13 , Figure 4 represents the target geometry relative to the 
camera, with C representing the camera, and P/, P 2 , and P 3 representing the three retro- 
reflectors on the target. The segment P'jA is perpendicular to CP' 2 . The segment P' 2 D is 
perpendicular to CP' 3 . The segment P' 3 B is perpendicular to CP',. Then 
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CP' 2 - CA + P' 2 A. Likewise, CP' 3 = CD + DP’ 3 , and and C?\ = CB - P^B. Using right 
triangle trigonometry, and using D and L as defined in the previous section, these three 
equations may be rewritten as follows: 

r 2 = r \ COS0 12 + Jd 2 -r, 2 sin 2 0 12 

r 3 = r 2 cos0 23 + yj L 2 - r 2 sin 2 0 23 

r x = r 3 cos0 13 - ^/Z) 2 -r 3 2 sin 2 0 ]3 

To solve for r x , r 2 , and r 3 , one makes an initial guess that r t = (^jcot^^j, then 

iterates the equations. If 0 12 < 0 13 , then the 2s and 3s in the above equations should be 
reversed. 
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: Projection of target onto image plane Figure 4: Target geometry for range solution 




